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Abstract 

In this paper, a hierarchical systematic design methodology 
of active fault tolerant control system is developed to 
accommodate partial actuator and/or sensor faults of 
Unmanned Underwater Vehicles (UUVs). An integrated 
sensitive Fault Detection and Diagnosis (FDD) mechanism is 
developed with acceptable time period and a computation 
load reduction for large number of actuators and sensors in 
the presence of system disturbances and random noise. An 
optimized robust reconfigurable controller design is 
presented based on singular value decomposition (SVD) 
principle and eigenstructure assignment technique. The 
effectiveness of the proposed scheme has justified by 
simulation result on the decoupled steering subsystem of the 
Naval Postgraduate School (NPS) Unmanned Underwater 
Vehicles (UUVs). 
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Introduction 

Nowadays, control systems are everywhere in our life 
but unfortunately, they can't work perfectly at all time. 
The need to design controllers that guarantee both 
system stability and acceptable performance upon the 
occurrence of faults has been a hot topic of research. 
Faults being dynamic in nature, the fault-tolerant 
control system (FTCS) should be capable of 
accommodating them quickly, especially for complex 
systems e.g. unmanned underwater vehicles, 
aircraft/helicopter, spacecraft, hazardous chemical 
plants, and control of nuclear reactors. The fault 
tolerant control system (FTCS) is defined as a control 
system that possesses the ability to accommodate 
system component failures automatically (Y. M. Zhang, 
2008) (J. Jiang, 2005). A system is Fault Tolerant (FT) 
able to recover its original task after a fault occures, 



with the same or degraded acceptable performances. 
Fault tolerant control (FTC) approaches are categorized 
into two types (Y. M. Zhang, 2008): passive and active 
approaches. Passive FTC (PFTCS) can tolerate a class of 
predefined set of faults considered at the controller 
design stage and needs neither fault detection and 
diagnosis (FDD) schemes nor controller 
reconfiguration. Active FTCS (AFTCS) on the other 
hand, employs Fault Detection and Identification (FDI) 
scheme that monitors system performance to detect 
and isolate faults (S., Katipamula, Parti, 2005) (S., 
(Katipamula, Partll, 2005). Accordingly, the control law 
is reconfigured on-line. Figure 1 demonstrates the 
typical components of AFTCS that implies a sensitive 
FDD scheme to provide precise and the most up-to- 
date information about the system as soon as possible 
after the fault occurrence and controller 
reconfiguration mechanism that organizes the on-line 
reconfigurable controller to recover the pre-fault 
system performance. 



Reference! 




output 



FIG. 1 ACTIVE FAULT TOLERANT CONTROL SYSTEM (FTCS) 
COMPONENTS 

Since Unmanned Underwater Vehicles (UUVs) are 
widely used in commercial, scientific, and military 



41 



www.ijape.org 



International Journal of Automation and Power Engineering (IJAPE) Volume 2 Issue3, March 2013 



missions for various purposes, it is necessary to embed 
FTC paradigms into UUVs to increase the reliability of 
the vehicles and enable them to execute and finalize 
complex missions (A. Alessandri, , M. Caccia, G. 
Veruggio, 1997) (A. Alessandri, M. Caccia, and G. 
Veruggio, 1999) (M. Caccia, & G. Veruggio, 2000) 
(Podder T.K. & Sarkar N., 2001) (A. Healey, and D. 
Lienard, 1993). Earlier investigations of literature 
employed parameter estimation and state-estimation 
methods for fault detection and diagnosis in UUVs. 
The state-estimation method monitors the system 
status based on an analytical model, whereas the 
parameter estimation method determines the system 
status based on system identification, where the 
residuals refer to plant parameters, rather than state 
variables. The parameter-estimation method does not 
require the analytical model in advance. This is 
especially helpful in those areas where analytical 
models are not easy to develop. In this paper, a 
systematic active fault tolerant control system (AFTCS) 
design that integrates fault detection, diagnosis and 
accommodation is developed. The design procedures 
imply: (1) an integrated design of a model-based fault 
detection and isolation (FDI) technique using a bank of 
constrained Kalman filters estimators, (2) an obvious 
fault estimation algorithm is derived that can estimate 
the effectiveness factor of a detected faulty sensor or 
actuator in the presence of the simulated system 
disturbance and measurement noise, and (3) a flexible 
approach to an on-line controller reconfiguration 
design for the post-fault system to compensate for 
detected failures leads to performance degradation or 
damages to the system. A reconfigurable state feedback 
controller with reference input is designed to recover 
the pre-fault system both transient and steady state 
performance based on eigenstructure assignment 
technique and singular value decomposition (SVD) 
principle. This paper is organized as follows: Section 2 
provides system analysis. Section 3, fault detection and 
diagnosis. Section 4 shows the reconfigurable 
controller design. Section 5 presents simulation results 
for the steering subsystem of the Naval Postgraduate 
School (NPS) UUV with simulated actuator (rudder) 
failures. Finally, concluding remarks are made in 
section 6 followed by the list of references. 

System Analysis 

Unmanned Underwater Vehicle Kinematics 

The kinematic relationships for the unmanned 
underwater vehicles (UUV) modeling discusses the 



motion in six degrees of freedom (DOF). Figure 2 
shows the schematic diagram of UUV body's inertial 
coordinate axes definition and six motion components 
i.e. surge, sway, heave, roll, pitch and yaw. For marine 
vehicles, it is common to use the Society of Naval 
Architects and Marine Engineers (SNAME) notation 
summarized in Table 1 (SNAME, 1950). 




FIG. 2 THE SCHEMATIC DIAGRAM OF UUV BODY AND 
INERTIAL COORDINATE AXES DEFINITION 

TABLE 1 SNAME NOTATION USED FOR MARINE VEHICLES 



6 motion components 


Forces 
and 
moments 


Linear and 
angular 
velocities 


Positions 
And Euler 
Angles 


surge 
(motions in the x- 
direction) 


X 


u 


X 


sway 
(motions in the y- 
direction) 


y 


V 


y 


heave 
(motions in the z- 
direction) 


z 


w 


z 


roll 

(rotation about the x- 
axis) 


K 


V 


<p 


pitch 

(rotation about the y- 
axis) 


M 


1 


e 


yaw 

(rotation about the z- 
axis) 


N 


r 


4> 



There are two coordinate reference frames denoted as 
the body-fixed reference frame B (Xo Yo Zo), and the 
inertia-fixed frame I (XY Z) as indicated in figure A.l. 
The motion of the body-fixed frame is described 
relative to the inertial reference frame and the origin O 
of frame B is usually chosen at the center of gravity 
(CG) when the CG is in the principal plane of 
symmetry. The body-fixed axes Xo, Yo, Zo coincide with 
the principal axes of inertia with the longitudinal axis 
Xo pointing from aft to fore, the transverse axis Yo to 
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starboard, and the normal axis Zo from top to bottom. 
The position and orientation of the vehicle (x, y, z, <p, 6, 
i/>) are described relative to frame I, while expressing 
the linear and angular velocities of the vehicle (u, v, co, 
p, q, r) in the body-fixed coordinate system. 




FIG. 3 BODY-REFERENCE FRAMES FOR UNDERWATER 
VEHICLE 

The coordinates are grouped into two vectors as: 
V = W\ Vlf =[x y z <p 6 y/] T 



v = [vf v T 2 f =[u v a> p q r] T 



(1) 
(2) 



where r\ represents the vector of position and 
orientation of the vehicle in the inertial frame while v 
represents the vector of linear and angular velocity of 
the vehicle in the body-fixed frame. The six degrees of 
freedom (DOF) equations that are used to describe the 
kinematic transformation between frame / and frame B 
are given as (T. I. Fossen, 1994) (T. I. Fossen, 2002): 



77 = J(rf)v 



(3) 



where J(tj) is a nonlinear transformation matrix and can 
be written as: 



>i07i) 







J 2 (rj 2 )j 
Unmanned Underwater Vehicle Dynamics 



(4) 



The 6-DOF nonlinear dynamic equations of motion are 
expressed in a compact form as (T. I. Fossen, 1994) (T. I. 
Fossen, 2002): 



Mv + C(v)v + D(v)v + g(rj) = t 



(5) 



where M is the inertia matrix of the vehicle, C(v) is the 
matrix of Coriolis and centrifugal terms, D(v) is the 
matrix of hydrodynamic damping terms, g is the vector 
of gravity and buoyant forces and x is the control-input 
vector describing the forces and moments acting on the 
vehicle in the body-fixed frame. The body's inertia 
tensor corresponding to the body-fixed coordinate 
system Xo, Yo and Zo with origin O can be defined as: 







^ xz 





















(6) 



where L, I y and L are the moments of inertia about the 
Xo, Yo and Zo axes, respectively. L y = lyx, Ixz = 7a, and Iyz = 
Ly are products of inertia. Fossen (T. I. Fossen, 1994) (T. 
I. Fossen, 2002) simplifies the equations of motion as: 

..2 , ,.2 



(8) 
(9) 



Trfu-ur + a)q-x c (q +r )+y G {pq-r)+z a (pr-q)\ = X (7) 
n$p-co p+ur-y a {r 2 +p 2 )+z G (qr-p)+x G (qp-r)] = Y 
rri<b-uq + vp-z G {p 2 +q 1 ) + x G {rp-q)+y G {rq- p)] = Z 
hP +( J, -I y )qr+n{y G {co-uq+vp)-z G {v-(op+ury] = K 
I r q+(I x -I z )rp+n{z G (u-vr+a)q)-x G (d)-uq+vp)]=M 
1/ + (I y -I x )pq+nix a (u-G)p +ur)-y G (ii-vr+ct)q)] = N 

where m is the mass of the body, xg , yc and zg are the 
coordinate components of re. Due to the symmetric 
shape of UUVs, the center of gravity (CG) is usually 
taken as the origin O in such cases re = [0, 0, 0]. When 
the body axes coincide with the principal axes of inertia, 
it implies that the inertial tensor about the body's 
center of gravity is diagonal, i.e. 

I c =diagJ Xc ,I yc ,I Zc ) (13) 

Subsequently, a simple representation will be yielded 
as (T. I. Fossen, 1994): 

m(ii -vr + coq)-X 



(14) 
(15) 
(16) 
(17) 
(18) 
(19) 



m(o -co p + ur) = Y 
m(cb-uq + v p)-Z 

I } J + (I Xc -I Zc >P = M 
I z /HI yc -I, c )pq = N 

Decoupled Subsystems of Unmanned Underwater 
Vehicle 

Equation of motion introduced in the previous section 
is not practical for controller or observer design. 
Therefore, a control strategy for slender and symmetric 
vehicles is possible to separate the six-DOF equations 
of motion into non-interacting (or lightly interacting) 
subsystems, and design one controller for each 
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subsystem. For de-coupled control system design, we 
group together related equations of motion for separate 
functions of steering, diving, and forward speed (A. 
Healey, and D. Lienard, 1993) (T. I. Fossen, 1994) (T. I. 
Fossen, 2002) (B. Jalving, 1994). The three subsystems 
and their control and state variables are summarized in 
table A.2. Each subsystem has multiple states and a 
single control element. The steering subsystem controls 
heading errors, while the diving subsystem controls 
depth and pitch errors as well as the speed subsystem 
i.e. the surge subsystem controls the propeller dc motor. 
The steering subsystem dynamics is the most 
challenging one of the three almost decoupled sub- 
systems. 

table 2 Control and State Variables of UUV Subsystems 



Subsystem 


State Variables 


Control inputs 


Speed 


u(t) 


n(t) 


Steering 


v(t), r(t), ip(t) 


6r(t) 


Diving 


w(t), q(t), 8(0, z(t) 


5s(t) 



Steering Subsystem ofNPS UUV 

Under the assumption of nearly constant speed u ~ uo, 
the vehicle dynamics in sway and yaw can be 
simplified to: 



mu + mu r = Y 



Lr = N 



where 



Y = Y 6 v + Y r r + Y v v + Y r r + Y s S r 



N = N d v + N. r + N u u + N r r + N s S r 



(20) 
(21) 

(22) 
(23) 



For small roll and pitch angles we can assume that 
y/ a r . Based on the above assumptions, the linear 
equations of motion for the steering subsystem are 
expressed as (T. I. Fossen, 1994) (B. Jalving, 1994): 



m-Y 



mx r - Y 



mx r - N I- N 

Lf v z r 



1 w 



(24) 



Y v "o 


Y r - mu 


0" 


V 








N r - mx G u 





r 


+ 


N s 





1 





y. 








8. 



m-Y 

V 

mx r - N 



mx r - Y 
I z -N . 

z r 



Y, u n 



0' 

1 

(Y r -m)u 










r 




y. 



N v u o (N,.-mx G )u 







0.5m % 



1 







1 



1 



0.283L 




■0.377L 




v 
r 

¥_ 



(25) 



Naval Postgraduate School's work determines the 
values of constants and coefficients in (25). Substituting 
and finally, rearranging it into a state-space form, we 
have: 



(26) 








'- 0.6383 


-1.4439 


0" 


V 




f 




0.0591 


-0.4659 





r 


+ 









1 





y. 





0.1708 -0.2650 
0.1924 0.302 




1 
1 



(27) 



The equivalent discrete linear state space model 
representation of the given system can be described as: 



-k+i =Ax k +Bu k +w k 



y k =Cx k +v k 



(28) 
(29) 



where xk is the state vector R nxl , A is the system 
matrix R" x ", B is the control matrix R" x p, Uk is the 
input control vector Rp x1 , wk is the system 
disturbances, yt is the measured output Ri xl , C is the 
output matrix Ri xn , vk is the measurement noise with 
zero mean. Using zero order hold with a sampling 
period Ts = 0.1s, the discrete model parameters will be 
given as: 



0.9378 -0.1366 
0.005592 0.9541 
0.0002848 0.09769 
and q 



I rom (24) we can write: 



B-- 



0.01521 
0.01884 



-0.02777 
0.02943 



0.0009488 0.001484 




1 
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Modeling Faults 

The system model with actuator and/or sensor faults 
can be considered as (G. Liu, D. Wang, and Y. Li, 2004) 
(Y. M. Zhang and J. Jiang, 2002): 

x k+i= Ax k+ B f u k +w k (30) 

y k =C f x k +v k (31) 

where the actuator faults are modeled by: 

B f =B(I-r a ),r a =diag(y al , ya2 ,...,y ap ) (32) 

where yai, i=l, 2,..., p represent the control effectiveness 
factors that indicate the actuator multiplicative faults. If 
y a i= then there is no fault. If < yai < 1 then there is a 
partial fault or loss in control action. If y a i= 1 then there 
is a complete actuator failure. Similarly the sensor 
faults are modeled by: 



C f =(I-r c )C,r c = diag(y sl ,y s2 ,...,y ) 



(33) 



where y S i, i=l, 2,..., q, represent the effectiveness factors 
that indicate the sensor faults. If y S i= then there is no 
fault. If 0<y S i<l then there is a partial sensor fault. If y»= 
1 then there is a complete sensor failure. 

Fault Detection and Diagnosis 

Fault Detection and Isolation 

A model-based FDI technique is developed by using a 
set of constrained Kalman filters for fault detection and 
isolation (G. Liu, D. Wang, and Y. Li, 2004). Fault 
isolation for a set of components and/or a single 
component is achieved by generating structured 
residual signals sensitive to certain faults and 
insensitive to others by partitioning the input control 
matrix B to two input matrices Bind and Bexci 
consequently the input control vector uk is partitioned 
to Ufaci and Uexci respectively for individual actuator 
fault isolation. Similarly, the output matrix C is 
partitioned to two matrices Cinci and Cexci and so the 
output vector yk is partitioned to yinci and yexd 
respectively for individual sensor fault isolation. The 
system state space model of equations (28) and (29) 
becomes: 

Bexcl"excl(k) + W k (34) 

(35) 

where Bind and Bexdfor the i th actuator are given as: 



x k + i =Ax k +B 


inc 


UinclO 




Vinci ( k )~ 




~c 

w incl 


y k = 


_Yexcl(k)_ 




_C e xcl_ 



B incl - 



B 



cxcl " 



•• 
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• 0~ 


•• 





b 2i 
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•• 





b ni 
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• °_ 


|~b„ 




bip-i) 





bip-i) 


b 21 




b 2 (i-i) 





b 2(i-l) 


_ b nl 




b n (i-i) 





b n (i-i) 



.. b, 

.. b 



2p 



Similarly Cm and Cexci for the i th sensor are given as: 
















" 






c,2 • 


• c ln 







c (i-i»i 


C (i-1)2 " 


C (i-l)n 




















c (i+l)l 


C (i+1)2 


C (i+l)n 







_ c ^> 


C q2 • 





The discrete Kalman filter algorithm equations fall into 
two groups: time update equations (prediction) and 
measurement update equations (correction) 
represented as: 



x k +1 /k = Ax k/k + B u k 



x k +i/k+i ~~ A x k+1/k + g [y k+1 - C x k+1/k ] 



(36) 
(37) 



by suitable selection of The innovation updating gain 
matrix g provide decayed response for estimation error 
ek where: 

(38) 
(39) 



and 



from (28) and (37) we can write: 

e k+1 =(I-gC)Ae k +(I-gC)w k -gv k (40) 

squaring both sides and taking stochastic mean of (40) 
gives: 

Z ee (k + l) = (I-gC)AZ ee (k)A T (I-gC) T + 



(41) 



(I-gC)Z w (I-gC) T + gZ vv g T 



where Zee is the state estimation error covariance, Zww 
is the process disturbance covariance, Zw is the 
measurement noise covariance. The predictor-corrector 
equations for (34) and (35) can be written as: 

x k + i/k =Ax k/k +B incl u incl (k) (42) 

X k+l/k+l = A x k+1/k +g[y incl (k+i)- ^incl X k+l/kJ 

(43) 

The error covariance of (41) has become: 
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Z ee (k + 1) = (I - g C M ) A E ee (k) A T (I - g C incl ) T + 
(I " § C ind ) E ww (I - g C incl ) + gE vv g 



(44) 



taking the 1 st order variance of (44) and then solving 
for Zee and g. Fault detection here is reliant on 
determining ek that will be close to zero depending on 
available noise and system disturbances but after fault 
occurrence it will be considerably high. For each 
included set of actuators or sensors and for each 
included single actuator or sensor, a constraint Kalman 
filter estimator is designed (E. Larson, B. Parker, and B. 
Clark, 2002). Fault isolation has performed by detecting 
the faulty set, then isolating the faulty single individual 
component within the faulty detected set. The residual 
signals generated by the state estimators are affected 
by system disturbances and noise, so a suitable 
threshold value can be used for fault detection level 
depending on the real system. 

Fault Estimation 

After the fault has been detected and isolated in a set of 
component (or in a single component) the next step for 
fault diagnosis is to estimate the value of the post-fault 
system, sensor effectiveness factor in equation (33) and 
the control effectiveness factor in equation (32). For the 
fault-free system, the sensor measurement matrix will 
be affected after sensor fault from: 

C=[ Cl ,..., Ci ,...,c q ] T , i = l,2,..,q (45) 



to: 



C f =[c 1 ,...,(l-y si )c i ,...,c ] , i = l,2,..,q 



(46) 



where y S i represents the estimated effectiveness factor 
in case of a fault in the i th sensor. The discrete Kalman 
filter algorithm equations (36), (37) considering i th 
sensor faults will be: 



' A k+l/k + g[C f X k+1 + V k C *k+l/k] 



(47) 



Then we can have: 



A k+l/k+l — 

(i-gQ 

A k+l/k 

+ gC f x k+1 +gv k (48) 
using equations (28) and (36) we can write: 



""k+l/k+l 



•(I-gC)A(x k -x k J + (I-gC)x k 
(I-gC)w k +gC f x k+1 +gv k 



and equation (40) will be: 

e[ +1 =-(I-gC)Ae k +g ACx k+1 +(I-gC)w k -gv k 

where AC = C-C f =[0,..., Yil c i ,...,0] T 

The error covariance of (44) can be written as: 



(49) 



(50) 



XL (k + 1) = (I - g C) A XL (k) A T (I - g C) T + g AC I„ AC T g T (51) 
+ (I-gC)X m¥ (I-gC) T +gX vv g T 

where X f ee is the state estimation error covariance 
considering i* sensor fault, and X xx is given ssi 

^xx = E{x k+1 x k+1 } 



(52) 



from (41) and (51) we have: 

AE = EL-£ee=(I-gC)AAEA T (I-gC) T + 
g AC Z xx AC T g T 

Let AC = T S1 Ps 

md M i =gACZ„AC T g T 

M s =y s 2 i (gP s I M Pjg T ) = y s 2 i © s 



then 



where 



© S = gPs £xxPlg T 



(53) 
(54) 
(55) 
(56) 
(57) 



The effectiveness factor can be estimated as a mean 
value by rearranging non-zero elements of Ms and the 
corresponding non-zero elements of @s into arrays Msk 
and © S k respectively, so we can write: 



J =-(t ^) 



(58) 



where Ns is the total number of non-zero elements in 
Ms (or © s ) and k= 1,2,..., Ns. Similarly, for the fault-free 
system, the input control matrix that given as: 



B = [b 1 ,...,b i ,...,b p ], i = l,2,..,p 



(59) 



will be affected after actuator fault to: 

B f =[b 1 ,...,(l-y ai )b i ,...,b p ], i = l,2,..,p (60) 

where y ai represents the loss in control effectiveness 
factor of the i* actuator. The discrete Kalman filter 
algorithm equations considering actuator faults will be: 

x k+ i/k + i =Ax k/k +Bu k +gCAe k +gCABu k + 

(61) 

gCw k +gv k 

with AB = B - B f =[0,...,y ai b 1 ,..., 0] , equation (39) will be: 
e k+1 =(I-gC)Ae k +(I-gC)ABu k +(I-gC)w k -gv k (62) 

also error covariance of (62) can be written as: 
EL (k + 1) = (I - g C) A El (k) A T (I - g C) T + 

(I-gC)ABE uu AB T (I-gC) T + 

(i-gC)E ww (i-gC) T +g E vv g T (63) 



where E f ee is the state estimation error covariance 
considering i th actuator fault, and Xuu is expected 
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covariance of the control input. From (41) and (63) we 
have: 

AZ = ZL-2ee = (I-gC)AAZA T (I-gC) T + 
(I-gC)ABZ uu AB T (l- g C) T 



(64) 



LetAB = y ai p a (65) 
and M a =(I-gC)ABZ uu AB T (I-gC) T (66) 

then 

M a = y^((I - g C) (3 a Z uu Pi (I - g C) T ) = a (67) 
where a = (I - g C) P a Z uu pj (I -g C) T (68) 

The effectiveness factor can be estimated as a mean 
value by rearranging non-zero elements of Ma and the 
corresponding non-zero elements of ©a into arrays Mak 
and ©ak respectively, so we can write: 



= J_ r Y M ak 



(69) 



where Na is the total number of non-zero elements in 
Ma (or ©a) and k= 1,2,.. .,Na 

Reconfigurable Controller Design 

The activation of the reconfiguration process is 
constrained by the following condition (Y. M. Zhang 
and J. Jiang, 2002) (Y. M. Zhang and J. Jiang, 2001): 



<5\ Vi = l, 



(70) 



where 5' is the threshold level involved as a design 
parameter and £'k represents the errors in the 
consecutive control effectiveness factor estimation. The 
reconfigurable fault tolerant control system design is 
required to recover the pre-fault system both transient 
and steady state performance based on the accurate 
FDD, taking into account the performance degradation 
in the occurrence of actuator faults (Y. M. Zhang and J. 
Jiang, 2003). The system representation in (28), (29) is 
assumed to be both controllable, observable and input 
as well as output matrices are of full rank, then the 
state feedback controller of the form: 

u k =-Kx k +K forward r k (71) 

can be designed to find the gain matrix K Rm using 
singular value decomposition (SVD) principle for 
predefined eigenvalues {sj ; j = 1,2,. ..,m} where rk 
represents the reference input and Kforward denotes the 
feedforward control gain to achieve steady-state 
tracking of the reference input (T. Didier, J. Cedric, Y. 
M. Zhang, 2008) i.e. 

lim y = r (72) 

k— >+co 



By using a linear state transformation of the state 
vector xk to the input-closed state space as: 

(73) 



X k -TXjy 



The closed loop system model can be written as: 

x (k+1)T = (A T — B T K) x kT + B T K forward r k (74) 



where 



and I P is identity matrix Rv x v, 



A T =T _1 AT, B T =T _1 B 
The closed loop eigenvalues denoted by Sj and the j th 
right associated eigenvectors denoted by vj represented 
as: 

(A T — B T K) Vj = SjVj, j = l,2,...,m (75) 

rearranging (75) we can write: 
I 



Sj I-A T 



0„ 















= h Tj 






K Vj _ 




K Vj 



(76) 



Applying singular value decomposition (SVD) 
principle to hi, gives: 



h T . = L a P T 



(77) 



where Ljn and P T jn are the left and right singular vectors 
respectively and Gjn represents the set of singular 
values of hrj matrix. Through that principle, the 
achievable eigenvectors are located in the subspace 
with dimension determined by the number of inputs 
(rank (B)) and orientation determined by the matrices 
(At, Bt) and the desired eigenvalues Sj. As all column 
vectors {Pjk ,k=p+l,...,n+p} of the right singular vectors 
Pjn generated by using singular value decomposition 
(SVD) procedures satisfy the following condition: 



h Tj P jk = 



from (76) we can write: 





















K Qi 



(78) 



(79) 



Where Q R""", W Rp xi1 , then using singular value 
decomposition (SVD) based solution for the desired 
eigenvalues to construct the gain matrix K we have: 

W = KQ (g0) 



and gain matrix K is given as: 

K = WQ"' 



(81) 



The reconfigurable control law for the post-fault 
system can be written as: 

u k =-K f x k+ K| brward r k (82) 
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where Kf, KWward are the control gain matrices of the 
post-fault system. To achieve the same steady-state 
tracking of the reference input for the post-fault system 
(G. Liu, D. Wang, and Y. Li, 2004): 



BK forward -B f K forward 



(83) 



By the definition on another linear state transformation 
of the state vector Xk to the input-closed state space, the 
transformed system matrices are given as: 



n,n-p 



and I P is identity matrix Rw, 



(84) 



The control reconfiguration using eigenstructure 
assignment is used here to guarantee the stability of the 
reconfigured system by recovering the system 
eigenvalues and to recover the pre-fault system 
performance to the maximum extent by placing the 
eigenvectors as close to those of the original system as 
possible (D. Krokavec, , 2005) (A. Esna Ashari, A. 
Khaki Sedigh, M. J. Yazdanpanah, 2005) i.e. 
l{ =k(A T — B T K) = X.(A T -B fT K f ) = ^ ,i = l,2,...,n(85) 



Both (75), (76) can be rewritten as: 

(A T -B fr K f )v g =SjV e , j = l,2,...,m 



Sj I-A x 



K f Vg 



K fV fj 



= 



(86) 
(87) 



then applying singular value decomposition (SVD) 
principle procedures as previous steps to obtain the 
reconfigured gain matrix Kf. 

Simulation Results 

The following simulation results for the decoupled 
steering subsystem of NPS UUVs confirmed the 
effectiveness of the developed integrated AFTCS. The 
fault scenario is simulated as a partial actuator faults 
with effectiveness factor of 0.75 introduced at the 
sampling instants of 50 for the second actuator only. 
The proposed scheme uses six Kalman filter estimators, 
one for actuator group, one for sensor group, one for 
each actuator, and one for each sensor. Computer 
simulations are conducted using initial state vector x(0) 
=[0 0] T . Due to the pure integration in the yaw 
channel of the steering subsystem, there is an 
eigenvalue of one for the equivalent discrete model. 
The desired eigenvalues of the steering subsystem are 



chosen as Sj= {0.9158, 0.9094, 1}. Applying the 
proposed controller design algorithm to the given 
faulty conditions provides the achievable K and Kf 
respectively as: 



K = 



Kf = 



-0.1866 
-0.2971 
-0.2136 
-0.1405 



-0.0953 
0.1285 
0.0030 
0.1555 



0.0240 
0.1473 
0.0827 
0.3567 



To achieve the same steady-state tracking of the 
reference input for the post-fault system, simulation 
results are performed using: 



BK 



forward " 



B f K f( 



0.0052 
0.0064 
0.0003 



-0.0095 
0.0101 
0.0005 



In path tracking, we try to keep a constant heading 
angle 20 degree as a reference set-point for the heading 
angle of the steering subsystem. In simulating path 
tracking, the yaw rate of turn for the steering path is 
made to follow a reference input shown in figure 4. 
Figure 5 demonstrates the system output responses to 
fault-free system, the faulty system without controller 
reconfiguration case that declares the loss of control 
effect due to the simulated partial actuator fault, and 
finally, the post-fault system response with controller 
reconfiguration to show the effectiveness of the applied 
reconfiguration algorithm that recovers the pre-fault 
system both transient and steady state performances. 
The constrained Kalman Filter estimator for the 
actuators group has detected a fault at the sampling 
instants of 50 by tracking the actual faulty response of 
the system but the estimator for sensors group hasn't 
detected any faults and that is emphasized through the 
generated residual signals for actuators group and 
sensors group shown in figure 6 and figure 7 
respectively. The residual signals of sensor group are 
close to zero depending on available measurement 
noise and system disturbances. To isolate the faulty 
actuator, the generated residual signals for the first 
actuator and the second actuator are declared in figure 
8 and figure 9 respectively from which it is noted that 
the second actuator is responsible for the detected fault 
and that can be modeled as loss in control with 
effectiveness factor y a 2. Through the introduced fault 
estimation technique, the last estimate of the loss of 
control effectiveness factor i.e. ya2 is 0.74995 that is 
close to the simulated applied partial actuator fault. 
Figure 10 shows the rudder control signals provided 
through the designed reconfigurable state feedback 
controller with reference input in which it can be seen 
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that the reconfigurable mechanism is activated after the 
fault has been detected, isolated and estimated using 
the integrated fault detection and diagnosis (FDD) 
scheme. 




20 30 40 50 60 70 80 90 1 
Time(sec) 

FIG. 4 REFERENCE INPUT FOR THE YAW RATE OF TURN FOR 
THE STEERING PATH 
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" Output response without reconfiguration 

" Output response with reconfiguration 
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A. THE SYSTEM OUTPUT RESPONSE (Yl) 
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B. THE SYSTEM OUTPUT RESPONSE (Y2) 

FIG. 5 THE SYSTEM OUTPUT RESPONSES OF FAULT-FREE AND 
FAULTY SYSTEM WITH AND WITHOUT RECONFIGURATION 
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B. THE RESIDUAL FOR THE OUTPUT (Y2) 
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FIG. 7 THE RESIDUAL SIGNALS FOR SENSOR GROUP 

p 1 1 1 1 1 '. 1 r 





p TmW~.™miiriiw 























20 30 40 SB 



70 80 90 iOO 



A. THE RESIDUAL FOR THE OUTPUT (Yl) 




!>(} Citl 

Ttma(mBj! 
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FIG. 8 THE RESIDUAL SIGNALS FOR THE FIRST ACTUATOR 
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B. THE RESIDUAL FOR THE OUTPUT (Y2) 
FIG. 9 THE RESIDUAL SIGNALS FOR THE SECOND ACTUATOR 
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FIG. 10 THE RUDDERS CONTROL SIGNALS 

Conclusion 

This paper presents an active fault-tolerant control 
system (AFTC) to accommodate partial actuator and/or 
sensor faults of Unmanned Underwater Vehicles 
(UUVs). The induced systematic approach provides 
sensitive and robust fault detection and diagnosis 
(FDD) system, a reconfigurable control design in a way 
that will preserve the stability of the system, 
combination of control reconfiguration and FDD 
system, a short and acceptable time period as both fault 
detection and isolation processes are achieved 
simultaneously as well as a computation load 
reduction for large number of actuators and sensors in 



the presence of system disturbances and random noise. 
The developed flexible approach based on Singular 
Value Decomposition (SVD) solution for eigenstructure 
assignment (EA) technique offers a powerful way to 
select robust reconfigurable control based on known 
state-space models of a dynamic system. The 
performances of the control reconfiguration approach 
are emphasized by simulation results of the fault-free 
case, the faulty case without reconfiguration and fault 
accommodation with controller reconfiguration. 
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